int32 idx
std_msgs/Header header
geometry_msgs/Pose pose
sensor_msgs/PointCloud2 lidar
sensor_msgs/PointCloud2 ground_estimate # estimate
